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1. INTRODUCTION 

Intelligent transport systems (ITS) vary in technologies applied: basic traffic signal control systems, 
automatic number plate recognition, speed cameras to monitor security systems and the like. Mechatronics sys- 
tems (MS) include a combination of mechanical, electrical, telecommunications, control and computer science 
technologies. The robotics (R) involves design, construction and use of robots and draws on the achievement 
of computer, mechanical or electronic engineering and mathematics. 

In particular ITS, MS and R include management metods such as automatic navigation systems, ve- 
hicle control and automatic driving. There are a multitude of papers about this topic. Here we cite some of 
them as example [1]-[5]. This work is conncerned about these topics, specifically about lane keeping control 
and lateral control. 

There is a wide of literature on current developments in the field of lateral and lane keeping control 
of autonomous vehicle motions [6]-[8]. In robotics, for example, the concept of lane-keeping motion planning 
algorithms for mobile robots in order that the robot does not leave the lane if collision-free motion is available 
introduced in [9]. The road agency formation unit (RAFU) functions have been studied in Approximation 
Theory (the interested reader can see [10]-[17]). In this paper, the RAFU functions will be called the Taxi 
functions. 

As when we use a taxi, the taxi driver take us to the destination, from knowledge of the exact positions 
of several points of the road centerline and a width of the route, our main goal in this work is to obtain RAFU 
continuous functions that connect the initial point with the final point of a certain trajectory without touching 
the sides of the road. To achieve this aim, we only need that the robot has the necessary technology to know 
the exact positions of some points of the route that it needs to follow at any time. 

In this work we are not concerned about what the machine must do in case of any obstacle appears 
on the road. On this subject one can see for instance, [18]-[22]. Until now, RAFU functions have not been 
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employed for this purpose. But given the ease and the accuracy with which these continuous functions approx- 
imate any step function and, therefore, any continuous trajectory, we think that the use of these functions in 
ITS, MS and R could be useful, specifically in lane keeping and lateral control. Moreover, the easy control of 
the possible error made on the approximation of the exact route is another advantage in practice. 

In section 2 we solve the lane keeping and lateral control problems in case of the routes are straight 
and perpendicular all of them. Section 3 is devoted to solve the same problems in case that the trajectory is 
a continuous function. The lane keeping and lateral control problems in case of an arbitrary trajectory on the 
plane is studied in section 4. Concluding remarks are in section 5. This paper is illustrated with some examples. 


2. TRAJECTORY WHERE ALL ROUTES ARE STRAIGHT AND PERPENDICULAR 

Definition 1 Given an arbitrary function f defined in |a, b| and let P, = {ao = a, £1, ..., £ = b} be 
a partition, we define the RAFU Method on approximation to the function function f to all approximation 
procedure that uses functions C,, defined in [a,b] to approach the function f where the functions C, (x) are 
defined by (1). 











Cr(x) = f(@i) + 5 [f (æi) — f (£i—1)] - Fnp(ti-1,; £) (1) 
i=2 
being (2). 7 
_ fai — at OPP — Ti- 
PnP) = realy a + PYRO A 


with p > 1 a natural number. The functions C„ (x), n € N are called RAFU Functions. 

Suppose we know that (Xo, kı), (x1, kı), (x1, k2), (xa, k2), T2, k3), (x3, kg), (%s-1, ks), (as, ks) 
are the exact positions of the vertices of a trajectory F(a) in which all streets are straight and perpendicular 
and suppose that it verifies that x; < x; forall 0 <7 < j < s. With this notation, the following Proposition 
can be established. 

Proposition 1 Let P, = {£o = a, £1, ..., £s = b} be a partition of [a,b] and let E(x) be a step 
function defined in |a, b] by (3). 





E(x) = kı ` X[x0,01] ag Xo ki ` X(xi—1,£:] (3) 


1=2 


with k; real numbers and Xe a(x) the function defined by Xica (x£) = 1 if x € [c,d] and xie, (£) = 0 if 
x é [c,d]. 
For all n > 2, if ste a) < 6(s), being ô (s) = in |x; — xi—ı| and K > 2 a positive integer, it 


m 1< 
follows that 


25 (Ms-ms) if 


s— ô(s ô(s 
1. |Cn(x) — Es (x)| nyn v [a, b] yzi (z: - ©, 2; +E) 


IA 











K 
2. |[Crn(x) — [ki (1 — ar) + ki+i@zr]| < LUi ifi = 1,...,s — 1 and x («i A) r l a) 
where M, and ms are the maximum and the minimum of the ki , az € (0,1) is a real number which depends 
only on x and (Cn), is the sequence of RAFU functions associated to Es according with (1) and defined as 


(4). 
Cr(a) = ky +Y. [ki — Bia] « Fn,2(@i-1, 2) (4) 
i=2 


being Fn 2(£i—1, £) for each i = 2, ..., s the functions defined in (2) for p = 2. 
A proof of Proposition 1 can be seen in [17]. 
2* (Ms—-ms) 


The expression Error (n) = ae 


give us the maximum distance between the Taxi Function 


Cn(x) and the real trajectory Æ. (x) along the road centerline. In this sense, fixed a certain K, for any n > 2 
we can know Error (n) and reciprocally. 
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In practice we would work in this way: first consider a maximum error bound Error (n), then we 
calculate 6(s) and K = Int[loge — 21 and finally we find the value of n in order to determine the Taxi 
function C, (x) that the robot must follow. 

Example 1 Suppose that the trajectory that a car must follow consists of 13 straight and perpendicular 
streets of 2275m long in total and it is given by means the step function 





40 if 20< z< 150 
350 if 150 <2 < 600 
200 if 600 < z< 750 

Ex(x)=410 if 750<a2< 925 
80 if 925 <a#< 1100 
250 if 1100 < x < 1200 
75 if 1200 < x < 1400 


In this case 6 (s) = 100 and 





holds for alln > 2 when K = 6 
According to Proposition 1, for all x € {20, 1400], 


2K (M,—ms) 26 (350 — 10) 


IC, (a) — E7(x)| < Error (n) = ion = ie 


In Figure 1 we represent the exact trajectory E'7(x) (red color) and its continuous approximations 
C'49(a) respectively (blue color). 
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Figure 1. Approximation to a step function 


In section 2 we have applied the result to the particular case in which the journey is defined by a step 
function, but in [10] we studied how the RAFU functions can be used to approach an arbitrary discontinuous 
function. 


3. TRAJECTORY DEFINED BY A CONTINUOUS FUNCTION 

Suppose that inside a machine we know the exact positions of some points (xo, f(%o)), (a1, f(#1)), 
ws (Zn—1, f(@n—1)) and (£n, f(£n)) of a continuous trajectory f(x). 

Definition 2 Let f be a function defined in [a,b]. The modulus of continuity of f, w(f,h), is the 
maximum of | f(x) — f(y)| foralla < x,y < b, |x- y| <h. 


3.1. Case of a uniform net 
Let [a, b] be an interval and suppose the case in which the values x; verify 1; = a + i- ue for each 
i =0,. 


ee 
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Proposition 2 Let P, = {xo = a, £1, ..., En = b} be a partition of [a,b] with xj = a + j - 4, 
j = 0,1.,...,.n and let E, be the step function defined by (5). 
ky zE la, zı] 
k E€ (£1, . 
Ae eS eel kj ER, j=l,...n (5) 


kn xE (&n-1,)] 


Let Cn be the RAFU function associated to E, defined as (4) by Cn (x£) = kı + B ;-alk; — kj_-1]- 
Fn,2 (£j—1, £). Then, for all n > 2 it follows that: 


1. |Cn(a) — En(a)| < *MaPolit a € [a,b] a G2, te + 2) 


3n? 





2. |[Cn(x) — [kj(1 — az) + kj4102]| < HM ta) if x € (a; — &*,0; + &*) and j = 1, n — 1 
being Mn and m,, the maximum and the minimum of the k; respectively and a, € (0,1) a number that 
depends upon x. 

Theorem 1 Let f be a continuous function defined in |a, b] and let P, = {x0 = a, £1, ..., &n = b} be 
a partition of [a, b] where x; = a + i- h for each i = 0,...,n and h = ba. Then there exists a sequence of 
radical functions (C,,),, defined in [a,b] as (1) such that 


2(M —m) 
nyn 
for alln > 2 being M and m the maximum and the minimum of f in |a, b] respectively and w ( f, h) its modulus 

of continuity. 

The proofs of Proposition 2 and Theorem 2 can be seen in [17]. According to these proofs, we define 
the functions En (x) as in Proposition 1 but taking into account that kı = f (xo) = f(xı) and k; = f(x;) for 
all i = 2, ..., n and then its corresponding Taxi functions Cn (x) as in (4). In practice we would work in the 
same way that we have mentioned in section 2. 

Example 2 Given a route defined by the continuous function f(x) 


75 if 20 < x < 80 
(2-200) $95 if 80 <a < 200 
f(x) = 527850 if 200 < x < 350 
150 if 350 < £ < 500 
=@=500)" 4150 if 500 <x < 800 


Under the hypothesis of Theorem 1, we know that 


2(M—m) (150-25) 5 800-20 _ 952 
n/n n/n 6 n ~ nyn 


In Figure 2 we show the results forn = 100. 





copie = 


175 
150 
125 
100 
re) 
50 





25 








200 400 600 800 


Figure 2. Approximation to a continuous function 
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It is important to observe that it is not easy to find the error Error (n) in Theorem 1 because 
of he difficulty to obtain the term w (f, h). So, what can we do? In practice, we can calculate A(f) = 


max | f(vi41) — f(x;)| and we could take this value instead of w (f, h). Some advantages of the use of the 


Taxi functions: 
e The value of n for the functions En (x) and Cn (x) is the same. 


The stability of the Taxi functions improves the instability of other families of approximating functions 
and this is an important contibution of this work. This can be inferred from Proposition 2 where we 
can deduce that between each two consecutive values x, and x,+, the Taxi functions Cn (x) take values 
between kr and k,+1. 


The functions F;,,, in (2) do not depend on the points x; but only on the subindices 7 (see p. 114 [12]). 
So, this reduces the calculations involved. 


The Taxi functions C(x) can be obtained with the only condition that the trajectory to approach is a 
continuous function. 


According to Proposition 2, the maximum error bound made with the Taxi functions depends only on 
parameters that are known. 


3.2. Case of a non uniform net 

Suppose the case in which the values x; form a non uniform net. In this case an analogous result to 
the Teorem 3.1 can be obtained. 

Theorem 2 Let P,, = {xo = a, 21,...,Us,, = b} bea partition of [a, b] with ô (sn) = nin |v; — zil 
and A (sn) = max |x; — x;_1| such that for all n > 2, er a) (s) < A (sn) < h being h = 4 and 


n 


K > 2 a positive integer. Let f be a continuous function defined in [a,b]. Then, there exists a sequence (Cn) 
defined in |a, b] as (1) for p = 2 such that 


n 


2* (M — m) 
nyn 


for alln > 2 and x € [a,b] being M and m the maximum and the minimum of f respectively and w (f, h) its 
modulus of continuity. 

A proof of Theorem 2 can be seen in [17]. 

To obtain the Taxi function Cn (x) we woul work as in the previous subsection. The same advantages 
hold in this case too. 


ICn(x) — f(@)| < +0 (f,h) 


4. CASE OF AN ARBITRARY TRAJECTORY ON THE PLANE 

Suppose the information we know inside a machine is the exact position of some values (zo, T(xo)) 
(x1, T(21)), «5 (@s—1, T(£s—1)) and (xs, T(xs)) that belong to a continuous trajectory on the plane (x, T (x)). 
Here we study what we can do when this trajectory is not a function. 

As (x, T(x)) is not a function, without loss of generality we can suppose that £o < ... < £i > Uj44 
for a certain i. There are two possible cases. 


ae) 


1). Case 1. It verifies that zo < ... < xı > x41 and T(x;41) < T(a;). Then we use the equations of the 
rotation around the center (x;, T (x;)) and through the angle a = 90° to turn the points (#41, T (£i+1)), 
ws (£s, T(£5)) into (£i+1,2, T(®i+41,2)), 5 (Ws,2, T(Xs,2)) respectively 


1 1 0 0 1 
U5,2 = Ti + T(z;) 0 —1 Tj 
T2(x;,2) =e + T (xi) 1 0 T(2;) 


forala+1<j<s. 


2). Case 2. It verifies that £o < ... < £i > £i+1 and T(zi+1) > T(ax;). Then we use the equations of the ro- 
tation around the center (x;, T (x;)) and through the angle a = —90° to turn the points (%;41, T(xi41)), 
wy (£s, T(£5)) into (£i+1,2, T(®i+41,2)), 5 (Us,2, T(Xs,2)) respectively 
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1 1 0 0 1 
X52 =| 2,-T(a;) 0 1 . Lj 
T2(xj,2) £i + T (zi) —1 0 T(z;) 


forali+1<j<s. 
In this way, we will reproduce the cases 1 and 2 as many times as necessary until the initial points (xo, T (xo)), 
(a1, T(x1)), .., (£s, T(£s)) have been turned into other points (£o, T(xo)), .... (£s,q, Tg(£s,q)) in which 
£o < ... < Zs q- So, the initial trajectory (x, T(x)) becomes a continuous function F(x) to which we can 
apply the explained in section 3. After then, we obtain the Taxi function C, (x) associated to F(x) for a certain 
n and then we recalculate for each x € [a,b] its the corresponding point of the real trajectory according to all 
the inverse rotations that this x has tested in order to give to the robot the real information to follow. 


5. CONCLUSION 

The RAFU method on approximation is an original approximation procedure. In this work we have 
showed how this method can be used to solve the lane keeping and the lateral control problems in intelligent 
transport systems, specifically in robot navigation. Given a trajectory on the plane, the Taxi functions can be 
useful to provide the necessary information to a vehicle in order to go from a place to another one autonomously. 
The proposed method holds for any trajectory and it does not depend on its regularity. Moreover the error 
bound that the Taxi function provides does not depend on any unknown parameter or of the regularity of the 
trajectory. Given the conciseness of the results of this paper, we believe that these avenues of research deserve 
some attention. 
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